SM.c

Go to the documentation of this file.

#include "derivative.h"
#include "compile_options.h"
#include "HAL.h"
#include "SM.h"
#include "Application_Globals.h"
#include "Compile_options.h"
/*
 ******************************************************************************
 * Constants
 ******************************************************************************
 */
/* each function represents a state within the State machine */
uint32_t (* const u32pfnState[])(void) =
{
  &u32fnSMInit, &u32fnStateError, &u32fnStateAcquisition, 
  &u32fnStateDecision, &u32fnStateDeployment, &u32fnStateSystemTest, 
  &u32fnStateGUI};
/*
 ******************************************************************************
 * Globals
 ******************************************************************************
 */
uint16_t gu16SMCurrentState[2u];
uint32_t gu32SMStateStatus;
/*
 ******************************************************************************
 * u32SMLaunch
 ******************************************************************************
 */
uint32_t u32fnSMLaunch(void)
{
  /* Init current state indicators */
  gu16SMCurrentState[SM_PREVIOUS_STATE] = SM_STATE_SETUP;
  gu16SMCurrentState[SM_NEXT_STATE] = SM_STATE_SETUP;
  
  /* State-machine related globals that should be initialized before jumping in */
  gu32SMCycleStartTime = CLEAR;
  
  for(;;)
  {
    /* Call the next state */
#ifdef DEBUGGING_NOW
    SIU.GPDO[9].B.PDO = 1;
#endif
    gu32SMStateStatus = (*u32pfnState[gu16SMCurrentState[SM_NEXT_STATE]])();
    
#ifdef DEBUGGING_NOW
    SIU.GPDO[9].B.PDO = 0;
#endif
  }
  
  /* We should never reach this point */
  return (CLEAR);
}
/*
 ******************************************************************************
 * vfnSMWriteNextState
 ******************************************************************************
 */
void vfnSMWriteNextState(uint16_t u16NextState)
{
  /* Take the current state and move it to the back */
  gu16SMCurrentState[SM_PREVIOUS_STATE] = gu16SMCurrentState[SM_NEXT_STATE];
  
  /* Make the next step actually the passed variable */
  gu16SMCurrentState[SM_NEXT_STATE] = u16NextState;
  
  return;
}
/*
 ******************************************************************************
 * u32fnSMValidateCurrentState
 ******************************************************************************
 */
uint32_t u32fnSMValidateCurrentState(uint16_t* pu16ValidStateList,
                                     uint16_t u16Size)
{
  uint32_t u32Status;
  
  /* Init status to incorrect value */
  u32Status = SM_STATE_IS_EXECUTING;
  
  /* Test to verify previous state ended correctly */
  if(CLEAR == (gu32SMStateStatus & SM_STATE_IS_EXECUTING))
  {
    /* Init to next incorrect state */
    u32Status = SM_INVALID_SOURCE_STATE;
    
    /* We will loop through all our values */
    for(; u16Size > CLEAR; u16Size--)
    {
      if(gu16SMCurrentState[SM_PREVIOUS_STATE] == *(pu16ValidStateList++))
      {
        /* If the previous state is found on the list, we are good */
        u32Status = CLEAR;
        break;
      }
      else
      {
        /* Keep looking */
      }
    }
  }
  else
  {
    /* Get out */
  }
  return (u32Status);
}
/*
 ******************************************************************************
 * u32fnSMInit
 ******************************************************************************
 */
//uint32_t u32fnSMInit(void)
//{
//  uint32_t u32Status;
//  
//  /* Verify that we can execute - Previous state ended correctly */
//  u32Status
//      = u32fnSMValidateCurrentState((uint16_t*)cau16SMInitValidInputStates,
//                                    N_ELEMENTS(cau16SMInitValidInputStates));
//  if(CLEAR == u32Status)
//  {
//    /* Here comes the real contents of the state */
//    LOCK_STATE_EXECUTION();
//    
//    /* Unlock the state */
//    UNLOCK_STATE_EXECUTION();
//  }
//  else
//  {
//    /* Leave */
//  }
//
//  /* Set the next state */
//  if(CLEAR == u32Status)
//  {
//    vfnSMWriteNextState(SM_APPLICATION_START);
//  }
//  else
//  {
//    vfnSMWriteNextState(SM_STATE_ERROR);
//  }
//  return (u32Status);
//}
/*
 ******************************************************************************
 *
 *  End of file.
 *
 ******************************************************************************
 */